# -*- coding: utf-8 -*-
"""
Created on Fri Jul 28 15:08:19 2017

@author: decardin
"""

"""
This module creates the collocation method
"""

from casadi import *
import numpy as np

def 